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© Motion compensation apparatus and method for determining heading of a borehole. 

(§) A method and apparatus is disclosed for measuring motion signals of ovroscoDes in doumhni* 
"S" te l ed J define the heading of a borehole. An IlustraZ SSSK the ttrJton 
^SSSJd ^^ n ^ l, ^ rlI,, "i may experience motion even while the drill KJb 

tri^JEL^£^ f ipS ^ n ^heading of the driD string is being determined. AcarferorSter 
fl «v2^ ? ta . * 0 I± ? ree orth °9 onal «es of a measurement sub are used ^tataunft 
aSS^nn^ fl 4 t a JS* time *" d al a second «* magnetic vectors n at tefira? time 

and Se SmSA^*! "2 ^ unlt Q^^^i vectors at the different times, S 

and the difference between the two unit magnetic vectors at the different times, An. are used along with 

the unit vectors $ and h and the difference in time At to determine the rotation vector of the probe Q p 
which has occurred during such time difference. The vector representing the rotation of the earth, Q* 
L!^ n H, C L et ! miine l b V subtractln 9 QP from the vector Q 9 from three gyroscope instruments placed 
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BACKGROUND OF THE INVENTION 



1. Field of the Invention 



This Invention finds application in certain measurement systems which determine the heading of a bore- 
hole of a well. For example, the invention relates to measuring-while-drilling systems (MWD) which are de- 
signed to determine the position and heading of a tandemly connected sub near the drill bit of a drill string 
assembly in an oil or gas well borehole. The Invention also finds application with wireline apparatus in which 
one or more down-hole Instruments are designed to determine the position and heading of such instruments) 
dunng logging of an open hole borehole. In particular, the invention relates to the determination of the heading 
of the well from gyroscopic data regarding the earth's rotation and from accelerometer data regarding the 
earth's gravitational field. Still more particularly, the invention relates to an apparatus and method for com- 
pensating gyroscopic data for movement of a down-hole measurement instrument while a heading determi- 
nation is being made. 8 

2. Description of the Prior Art 

Prior art measuring-while-drilling equipment has Included magnetometers and accelerometera disposed 
on each of three orthogonal axes of a measurement sub of a drill string assembly. Such measurement sub 
has typically been part of a special drill collar placed a relatively short distance above a drilling bit The drilling 
bit bores the earth formation as the drill string is turned by a rotary table of a drilling rig at the surface 

At periodic intervals, the drill string is stopped from turning so that the measurement sub in the well bore 
may generate magnetometer data regarding the earth's magnetic field and accelerometer data regarding the 
earth's gravitational field with respect to the orthogonal axes of the measurement sub. The h vector from the 
magnetometer data and the g vector from the accelerometer data are then used to determine the heading of 
the v/ell. • 

Such prior art method suffers from the fact that the earth's magnetic field varies with time and is affected 
by structures containing iron or magnetic ores in the vicinity of the measurement sub. Such variation leads to 
errors and uncertainty in the determination of the well heading. 

Such variation in the heading determination of the measurement sub of a MWD assembly, ora similar wire- 
line instrument, can theoretically be eliminated by adding gyroscopes to each of the orthogonal axes of the 
measurement sub. In theory, the heading of the measurement sub can then be determined from accelerometer 
data from each of such axes and gyroscopic data from each of such axes. The accelerometer data Is responsive 
to the gravitational field of the earth, while the gyroscopic data is responsive to the rotational velocity of the 
earth with respect to inertia! space. 7 

Movement of the measurement sub (in the case of an MWD application) while accelerometer and gyro- 
scopic data is being taken can introduce an error into the determination of the earth'e rotational velocity vector 
Such movement may be caused by the twist* or torque on the drill string after it is stopped from rotation and 
it te suspended from slips in the rig rotary table. Such twisting motion may occur on land rigs or on floating 
dnlhng rigs. Motion may also be produced while drilling has been suspended fora heading determination in a 
floating drilling rig where the heave of the sea causes the drill string to rise and fall in the borehole. Rotation 
of such drill string may be caused due to wave induced reciprocation of the measurement sub along a curved 
borehole. Analogous errors may occur in the case of a wireline instrument 

SUMMARY OF THE INVENTION 

A primary object of this Invention Is to provide an apparatus and method to compensate for rotation induced 
errors for an Instrument which uses gyroscopic measurements for determining the heading of a borehole 

An Important object of this Invention is to provide a specific application of the Invention In an apparatus 
and method Iter compensating gyroscopic measurements of a MWD measurement sub forrotation of the meas- 
urement sub itself while accelerometer and gyroscopic measurements are being made. 

Another object of this invention is to provide a measurement apparatus and method for determining the 
direction of a well through the use of accelerometer and gyroscopic measurements where possible corrections 
for rotation of the apparatus are measured using accelerometer and magnetometer measurements. 

The objects identified above, along with other advantages and features of the invention are illustrated in 
i embod,me nt In a ™»«hod and apparatus for reducing a source of error in measuring-while-drilling 
MWD) equipment The Invention Is also intended for application in wireline instruments. In the MWD applica- 
tion of the invention, a measurement sub is provided having a separate accelerometer. magnetometer and gy- 
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repenting the earth's magnetic field w.th respect to the sub coord.nate system la deteZZat a first time 
t, and again at a second time t 2 to produce unit vectors and and a difference unit earth magnetic 
field vector, A « . A unit vector representing the earth's gravitational field with respect to the sub coordinate 
system is determined at the fi^^ fti 
and a difference unit earth's gravitatlona. field vector. A 3 . The time difference At between t, and t 2 is also 
determined.FmmthevectorsAfiA.A8 . ft, and the time d.f fere nce At. a vector Q" representative of 
the angular rotation velocity of the measurement sub or "probe- is determined. Determination of °" allows 
the gyroscopicvector measured duringsuchtime.fr, to be corrected to determine the actual earth's rotational 

velocity vector Q\ Such vector and its components along with the accelerometer determinant «r »h„ w 
gravitationai field aDow a determination of the heading or the dlrec^oTZZ^T 

BRIEF DESCRIPTION OF THE DRAWINGS 

roscop,c data where the gyroscopic data has been corrected for movement of the sub ftsej * 
DESCRIPTION OF THE INVENTION 

»fj?r , 1 reP .? 38n , t3 a " l,,U8trat,ve embodiment of the Invention for a MWD application As mentioned 

characteristics while driBlng. Although the Invention Is described to ? SSnTTSS dSl £ ? 
onment the invention wli, find app,.^ 

^J? IT* 10 ? f pparatus te tended from a drill string 6 which is turned by a rotary table 4 on the drill 

■JSffiS SKSSSSST? ? ' n . StnJmentS * ^ F (WhiCh m ^ not todude the 
illustrated stabilizer blades) are stored downhole. Such signals may be telemetered to the surface ™ ™J1~ 

tional measuring-while-drilling telemetering apparatus and methods. For ^iSSE 
sub or conar M of this invents, as weO as other conventlona, coLe F J^S^J^SX 
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the drill string 6. Such collars and tools form a bottom hole drilling assembly between the drill string 6 and the 
drill bit B. 

As the drill string 6 and the bottom hole assembly turn, the drill bit B bores the borehole 9 through earth 
formations 32. An annulus 10 is defined as the portion of the borehole 9 between the outside of the drill string 
6 including the bottom hole assembly and the earth formations 32. Such annulus is formed by tubular casing 
running from the ship to at least a top portion of the borehole through the sea bed. 

Drilling fluid or "mud" is forced by pump 11 from mud pit 13 via standpipe 15 and revolving injector head 
8 through the hollow center of kelly 3 and drill string 6, through the subs T, M and F to the bit B. The mud acts 
to lubricate drill bit B and to carry borehole cuttings upwardly to the surface via annulus 1 0. The mud is del ivered 
to mud pit 1 3 where it is separated from borehole cuttings and the like, degassed, and returned for application 
again to the drill string. 

Measurement sub M, as illustrated in Figures 2A and 2B is provided to measure the position of the down- 
hole assembly in the borehole. Such borehole may be curved or inclined with respect to the vertical, especially 
in offshore wells. The sub M includes a structure to define x, y and z orthogonal axes. The z axis is coaxial 
with sub M. On each axis, a separate accelerometer, magnetometer and gyroscope is mounted. In other words 
signals represented as G w H x , Oifc Gy, H r Ofy and G* l* x are produced and applied to micro computer 
C disposed In sub M. Such signals are transformed to digital representations of the measurements of the In- 
struments for manipulation by computer C. 

The signals G„ Gy and represent accelerometer output signals oriented along the x, y, z axes of the 
sub M; H x . Hy, and H z signals represent magnetometer signals; Q0y, and Q* z signals represent gyroscope 

In operation, drilling is stopped periodically, so that measurements of sub M can be performed to determine 
the heading * with respect to the vertical. In other words, a heading of *=0 means that the well is inclining or 
heading toward earth's geographic north. A heading of $=90<» means that the well is inclining toward the east 
and so on. 

The heading of the welibore can be found using the tri-axial set of accelerometers G*. Gy, G* and the tri- 
axial set of gyroscopes ^ tt»y, na,, to resolve the earth's gravitational field G and the earth's rotation vector 

Q into their components along three orthogonal axes. The rotation vector Q* represents angular velocity 
of the earth with respect to inertial space. 

If the z axis of the measurement sub M is parallel to the axis of the welibore, the direction of the borehole 

-» 

* can be determined from the vector components of G and as 



tan ft) = SklsjLr 9 y <. (1) 



where 



6 ih 



is a unit gravitational vector with components g x , g z 
and 



i n*i 



is a unit earth rotational vector with components <»%, ©%, <ai* z . 
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The term | | , or absolute value of the accelerometer vector is defined as 

I ^ I = VG X 2 + <V + G 2 2 
The angular velocity vector 3« as measured by the gyroscopes is the sum of the angular velocity vector 
0' of the earth and the angular velocity vector 3* of the probe. In other words. 

When the drill string 6 is suspended in the rotary table 4 bv alios and la nnt h«in« u. 
the measurement sub M in the borehole can be a large sour* SZSS l^SSStJJ^ ° f 
result from twisting of the drill string due to residua, torsional energy of £ mSEK JESSE 

^ This invention includes epparatus andamethod for independently determlningtherotation velocity vector 
O p of the sub or -probe" reiatlve to the earth, and then determining the earth's rotation vector Z* bysub- 

tracttng Q p from the rotation vector Q° determined from the gyroscopes. 

can^Sr 6 ^^ 



JUL s Oxd' 
dt 

For finite time steps, equation (2) becomes 
AO = OxQ p At 



dt « 



(3) 



The vector Q p can be resolved Into components parallel and perpendicular to 0 by forming the cross 
products of the left and right hand sides of equation (3) with 0 : 

AOxO = (OxQ p At)xQ, 



AO x 0 = Q p At - (0 • Q p At)0 



or 



Q p At = AOxO + (0 • Q p At)0 



(4) 



In equation (4). Q p At is expressed as the sum of two components. The component A 0 x 0 isperpen- 
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dicularto 0 . The term ( Q • n p At) H p | s parallel to 0 . 

Because the gravitational field vector G (obtained from G x , G y , G z accelerometers) and the magnetic field 
5 -> 

vector H (obtained from H Xf Hy, H z magnetometers) are both fixed in the earth's frame of reference, two equa- 
-» 

tions can be written for Q p At: 

10 

Q p At = A§x§ + (§ -QfiA\)§ (5) 

15 and 

Q p At = Afi X fi + (fi • Q>At)fi (6) 

20 

where d and fi are unit vectors along the earth's gravitational field vector G and the earth magnetic field 
vector H, 



9 -| where | G | = ✓ G, 2 + G y 2 + q* 

. 

6 = \W\ ' ^ ' = ^ MS + Hy 2 + Hj 2 

Equating the right hand sides of equations (5) and (6), the equation becomes, 

40 

A§ X § + (Q • Q"At)§ = Afi x fi + (fi • Q"At)fi (7) 

<5 Two equations for the unknowns ( 9 . O p At) and ( fi - Q p At), are obtained, for example, by forming the 
dot products of equation (7) with any two linearly Independent vectors A and B : 



30 

and 
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(AS X 0) • A + @ • Q"At)9 . A = (Afi x fi) 1 + (fi • QPAt)fi ^ (8) 
(A0 X 9) • B + (§ • Q'AtJfl • B = (Afi X fi) • B + (fi • QPAt)fi -"5 (9) 



7 
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Equations (8) and (9) can be put In matrix form and solved for ( £ - Q p At) and ( fi . O p At): 



w 



15 



20 



30 



40 



50 







r d • o p At 


1 


.0-1 


— fi • B 


1 fi-Q'At, 





(Afixfi) A - (A0x 
(Afi x fi) • B - (A$ x 



(10) 



and 



One possible solution of equation (8) and (9) is to choose 

A - Afixfi, 

~b = a§x a. 



For such a selection, equation (8) can be solved directly for ( § . flT A t) and equation 9 solved directly 
for fi • Q p At 

Figure 2B illustrates the microcomputer C which Is disposed In measurement sub M. Several computer 
programs or sub-routines are stored In micro computer C to accept representation of signals from each of the 
accelerometers. magnetometers and gyroscopes. 

Computerprogram 30 JabeledMagnetometerComputer program (unrt vector), accepts magnetometer sig- 
nals H x . H y and H z signals at times t, and t 2 as received from dock 32. The unit vector fi is determined at 

ZtlT^\ a ^ i2An " eaentatton0Hhamn ™«™ 6,1 and ^ ^ applied to computer program 36 
forfurthe use. In the same way. the computer program oraulw«*ne 34 accept,.^ flC<v«^* 

35 celerometers of measurement sub M. Computer program 34 determines unit gravitational flelc iTeSore* tte 
times t, and t* Such vectors ^» and are applied to program 36. 

The computer program 36 first determines the difference between sequential measurements of d M and 

ifmHOHJX? ^ '"^^•-^^"totlonofAdandA « Is determined. The representation of 
At, the time difference between the sequential measurement times, Is alao applied to computer program 3& 

Computer program 36 uses representations of A fl . » . A fi . fi along with arbitrary vectors * and 
( and selected to be linearly Independent of one another) to produce a representation of ^At Either 
the Qti , or the or the mean value between such vectors may be used as $ . Likewise, the or ^ or 
the mean value between such vectors may be used as fi . The program 36 has a data input of At from dock 

32. Accordingly, the At representation is used with the representations of Q p At to produce representations of 
uy x , ijp y . n? z which are applied to gyroscope correction computer program or sub-routine 38 Program 38 also 
accepts gyroscope signals flu,, OH z . It then determines the difference of the probe rotationsignals C» 
np y . Op from the gyroscope signals no x , no y , c» z to produce corrected earth rotation signals. Q> n- Q- fo r 

S^n^haT" " " ,b * 0MnB 40 Wh,Ch ProdUC6S Unit r *<™°^° " 



8 
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= -Ol , where | Q 9 | = J Q f2 + Q a2 + q* 2 



Next, the representation of the unit vector is combined with the representation of the unit vector & from 
program 34 to determine a corrected borehole heading 4 according to the relationship of equation (1) above 
The signal 4 is applied to telemetry module T for transmission to surface instrumentation via the mud column 
10 of drill string 6, standpipe 15 and pressure sensor 21 as illustrated In Figure 1 . 

Practical aspects of the Invention deserve mention. The gyroscopes used in this Invention are preferably 
ring laser gyros. Fiber optic gyros or mechanical spinning mass gyroscopes may be used which are suitably 
protected to survive mechanical shocks of a downhole drilling environment 

« The method outlined above does not take into account sources of uncertainty in the measurement of 8 

and fi. . Brors In the measured ^ and fi. time sequences can result in an inequality between the left and 
right hand sides of equation (7). Since equation (7) Is a vector and must hold along any coordinate axis it is 
a in fact equivalent to three scalar equations. 

Since there are three equations and only two free parameters, the system of equations is over constrained. 
The method described above guarantees that the left and right hand sides of equation (7) will be equal in a 

plane containing the vectors A and B but they may not be equal on a line perpendicular to that plane as a 

result of errors in the measurement of Q and fi. . The value of Q p obtained will depend on the choice of vectors 
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A 



and B which has been made arbitrarily and without any consideration of which choice is "best" . It is useful 
to determine the "best" estimate of the true rotational velocity of the probe given the uncertainties in the meas- 
urement of A § andA°\ 

Since A fl and A .fi are both 3 dimensional vectors, a single measurement of A »d and A fi can be viewed 
as a single sample of a 6 dimensional random vector. The uncertainties in the measurements can be expressed 
35 in the form of a 6X6 co variance matrix, K, in which each element of the covariance matrix is the covariance 
between two of the components of the random vector. The covariance matrix can be determined by analyzing 

the sources of uncertainty in the measurement of A $ and A fi . Assuming that distribution of measurements 

of A 9 and A fi obey a Gaussian distribution for multidimensional random variables, it is necessary find the 
-r 

valueof Q which maximizes the probability of obtaining the observed values of A. § andAfi. The maximum 
likelihood estimates of A 9 and A fi , A ft* and A fw , are computed from the maximum likelihood estimate 



of from the equations: 



AOm-ttXfiPj At 
Afi mI = (fiXQPj At 

The probability of observing the measured value of A 9 and A fi is proportional to the quantity: 



9 
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exp /-</*/ | . icl/ A9 " A9ml 

lAfi-Afi ml 



Tomaximize the probability of observing the measured valuesofA§ andA fi -,thefactor in the exponential 

lemlnlmlzedbytreatingthethreeoomponentsof Of as free parameters which are allowed to vary. The value 

-» -» •* 

of Q so determined is the maximum likelihood estimate of 0 * QP -m- 

v ^"9 modifications and alterations In the described methods and apparatus which do notdenart f mm 
he s P W of the Invention will be apparent to thosesWIIed in theart of ma^ 

these Ranges are desired to be Included in the appended claims. The appeVdTcS"Ste the^ o^vZJ ' 

^ h f ? re89nt i nventi0n ' ^ de8Cflptlve manTOr whfch employed for settog ZS^^i^ 
should be interpreted as illustrative but not limitative. -« setting rortn me embodiments 

Claims 

1. Apparatus operatively arranged for measuring characteristics of a borehole comprising 

a measurement instrument operatively arranged for placement within said borehole said instru- 

~ m P u te'™ans response to said nu^met^^^^ 
earth's magneticfleld with respect to said Instrument coordinate system at a first Hmet,. that b fi ti, and 
at a later time t* that is fi * . and for determining a difference unit earth magnetic field vector, A ^ , rep- 
resenting that difference between ^ and fi,, , and for stofing , representation of a fi and fi - 

computer means responsive to said accelerometers for determining a unit vector ren«««nf inn th- 
earth's gravitational field with respect to said instrument coordinate sX at -SSSSXl 

Sn.andatalater time t* that is ^ .and for determining a difference unit earth gravitational field vector. 
A 9 . representing the difference between ^ and . and for storing a representation of A § and 

said seTd" m7JZ tin9 ' « the differe "~ in «™ * between said first time t, and 

computer program means responsive to said representations of A fi . fi , a « . 0 and At for deter- 
mining a vector Q P representative of the angular rotation velocity of said Instrument. 

* ^3SK2!S^ said instrun,ent has a separat9 9yrosoope fUed a,on ° — °< - 
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computer means responsive to said gyroscopes for determinina a vector QQ * 
.he rotations, velocity of the earth and the rotation* ve.ooity ^J^^JSS^. 

representation of said vector O" ; and 

computer means for producing a vector representative of the earth's rotational velocity O* with 
respect to said sub coordinate system by subtracting said vector " p 1nm M|d vector ^ a 

4 ' me:nTrX?he^uat; ein ™™ «6r determining a vector * lncl udes 

Ad X Q + (9 • QP At )3 = Afi X fi + (fi • Q» At )fi. 

5. In apparatus operatively arranged for measuring characteristics of a borehole «.M onn „™ ( . „ • ^ 
an ins^ment having a separate accelerometeTand mg^^&^ZZ^J^ 
of Its coordinate system, a method for determining the angular rotation velocltv of tL ^ 
placed within the borehole comprising me steps oft Y lnstrumen t when 

determining from signals of said magnetometers a unit vector representing the earth's magnetic 
field with respect to said instrument coordinate system at a f M time t, that is. fti . and a later time 
that Is, fits ; 

dete^iningadifferonceunaearthmagneticfieldvector.Afi.representingth^ 
fi e and ^ ; 

detennlnlngfrom signals of said aoceleromaters a unltvector representing the earth's gravitational 
field wlthrespecttosaid instrument coordinate system at aaid first timet,, that is ^ and at a later time 
t* that is Qtt ; 

determining a difference unit earth gravitational field vector. A 3 . representing the difference be- 
tween ^ , and ; and 

determining from representations of A fi. . fi. . a 6 3 and At a v«rt«, a" ~„ . . 
theangularrotetionvelocityofsaidinstrumenL Atavector 0 represented of 

6. ThemetlK,dofdaim5,whera^ 

7. The method of dalm 5. for use when said instrument has a separate gyroscope fixed alono each of «ih 

determining from signals of said gyroscopes a vector °° reoresentetivA nf th* m ^ • , ^ 
of the earth and the rotational velocity oYsaid measurement sub; and 

-> 

determining a vector representation solely of the earth's rotational velocity vector °" with respect 

-> 

to said sub coordinate system by subtracting said vector °" from said vector Q° . 
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8. The method of claim S.wherein said step of determining a vector ° includes the step of solving the equa- 
tion 



x § + (Q • Q p At)§ = Afi x fi + (fi . Q p At)fi. 

0. The method of claim 8 further comprising the step of computing the maximum likelihood estimate of 
-> 

QP 



10. The method of claim 9 f wherein the step of computing the maximum likelihood estimate of ° P Includes 
the step of minimizing the quantity " 




Afi - Afi ml 



where 



and 



AjL = (g X QP ml )At, 



Ahmi = (h X QP mJ )At, 

by treating the three components of qp as free parameters which are allowed to vary, with the value of 

"» -* 

O p qp O p , 

so determined being the maximum likelihood estimate of , . 
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